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ABSTRACT 

A  novel,  multi-segmented  magnetic  crawler  robot  has  been  designed  for  ship  hull  inspection.  In  its  simplest  version, 
passive  linkages  that  provide  two  degrees  of  relative  motion  connect  front  and  rear  driving  modules,  so  the  robot  can 
twist  and  turn.  This  permits  its  navigation  over  surface  discontinuities  while  maintaining  its  adhesion  to  the  hull. 
During  operation,  the  magnetic  crawler  receives  forward  and  turning  velocity  commands  from  either  a  tele-operator  or 
high-level,  autonomous  control  computer.  A  low-level,  embedded  microcomputer  handles  the  commands  to  the  driving 
motors. 

This  paper  presents  the  development  of  a  simple,  low-level,  leader-follower  controller  that  permits  the  rear  module  to 
follow  the  front  module.  The  kinematics  and  dynamics  of  the  two-module  magnetic  crawler  robot  are  described.  The 
robot’s  geometry,  kinematic  constraints  and  the  user-commanded  velocities  are  used  to  calculate  the  desired 
instantaneous  center  of  rotation  and  the  corresponding  central-linkage  angle  necessary  for  the  back  module  to  follow  the 
front  module  when  turning.  The  commands  to  the  rear  driving  motors  are  determined  by  applying  PID  control  on  the 
error  between  the  desired  and  measured  linkage  angle  position.  The  controller  is  designed  and  tested  using  Matlab 
Simulink.  It  is  then  implemented  and  tested  on  an  early  two-module  magnetic  crawler  prototype  robot.  Results  of  the 
simulations  and  experimental  validation  of  the  controller  design  are  presented. 
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1.  INTRODUCTION 

Routine  inspection  of  ship  surfaces,  including  the  hull,  deck  and  tanks,  for  corrosion,  damage  and  micro-fractures  is  an 
integral  part  of  ship  maintenance.  Such  inspections  are  labor-intensive  and  expensive.  A  magnetic  robot  equipped  with 
the  proper  sensors  may  accomplish  this  task  more  quickly  and  at  a  much  lower  cost. 

Magnetic  climbing  robots  for  inspection  of  ferromagnetic  surfaces  have  been  designed  and  tested.  Such  designs  use 
either  magnetic  wheels  or  tracks,  mount  magnets  in  a  central  plate  within  the  robot  that  can  be  raised  and  lowered 

in  order  to  vary  the  magnetic-adhesive  force,^’^’^^  or  use  a  combination  of  several  mobile  units  to  facilitate  climbing.^ 
The  majority  of  these  robots  are  restricted  to  operation  on  smooth  surfaces  that  are  either  flat  or  have  large  radii  of 
curvature.  Many  cannot  manage  wall-to-wall  or  wall-to-ceiling  comer  transitions.  Of  those  that  can,  the  magnetic 
snake-like  robots  constmcted  to  date  cannot  follow  curved  paths  since  they  have  minimal  to  no  lateral  flexibility.^^’^^’^^ 
The  Magnebike  robot  can  negotiate  comer  transitions  uses  a  lifting  mechanism  to  detach  its  front  wheel  momentarily 
from  the  magnetic  surface  to  facilitate  the  comer  transitions.^’^  However,  these  robots  are  unable  to  negotiate  ribbed 
surfaces  (see  Figure  1).  Groups  of  reconfigurable  modular  robots  have  been  proposed  for  negotiating  complex 
stmctures,  but  have  yet  to  be  demonstrated.^"^ 

The  Unmanned  Systems  Group  at  SPAWAR  Systems  Center  Pacific  has  developed  a  multi-segment  magnetic  crawler 
robot  (MSMR)  capable  of  traversing  the  complex  metal  surfaces  found  in  both  marine  vessels  and  transport  tanks 
without  losing  adhesion^^  (see  Figure  2).  In  its  simplest  configuration,  it  consists  of  two  driving  modules  connected  by  a 
roll-yaw-bow  linkage,  as  shown  in  Figure  3.  Each  drive  module  has  a  pair  of  magnetic  wheels  that  provides 
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adhesion  on  ferrous  surfaces.  The  wheels  are  driven  independently  of  one  another,  making  each  module  differentially 
driven.  The  roll-yaw-bow  linkage  provides  surface  adaptability  by  permitting  relative  twisting  and  turning  between  the 
modules  without  requiring  additional  motors.  The  drive  modules  contain  batteries,  control  electronics,  microcomputers, 
sensors  and  wireless  communication. 


Figure  2.  MSMR  prototype  on  shipping  eontainers. 


Figure  3.  A  two-module  MSMR  prototype  on  underside  of  stairwell.  A  pan-tilt-zoom  eamera  and  light  system  has 
also  been  installed. 


Since  each  wheel  is  individually  driven,  it  is  difficult  for  a  tele-operator  to  directly  control  each  motor  using  a  standard 
RC  controller,  as  was  found  during  initial  prototype  testing.  Coordinated  motion  control  between  the  front  and 
successive  drive  modules  is  needed.  Initially,  a  simple  control  algorithm  that  permits  the  rear  module  to  follow  the  front 
module  is  desired.  Leader- follower  control  has  been  applied  to  snake  robots.  In  such  research,  the  system  kinematic 
equations  are  used  to  calculate  the  position  of  each  robot  segment  at  the  next  time  step.  The  individual  segments  are  then 
commanded  to  these  positions.  Experimental  results  show  that  this  method  results  in  imperfect  following,  especially  as 
more  segments  are  added.  Other  methods  of  controlling  snake-like  robots  include  Lyapunov  methods,  shape 
controllable  points,  and  other  kinematic  methods. Many  of  these  approaches  are  complex  and  may  not  be  needed  for 
the  MSMR. 


The  MSMR  leader-follower  configuration  is  similar  to  a  tractor  pulling  a  trailer.  Kinematics,  dynamics  and  trajectory 
following  control  for  tractors  pulling  one  to  several  trailers  have  been  studied.  However,  the  trailers  are  typically 
passive,  so  actuators  are  limited  to  the  driving  wheels  and  steering  of  the  tractor  vehicle.  In  some  instances,  the  trailers 
are  also  steerable,  but  have  no  drive  power.  Although  the  solutions  presented  to  the  tractor-trailer  problem  are  not 
directly  applicable  to  the  MSMR,  a  similar  kinematic-based  approach  to  the  leader-follower  control  problem  is  applied 
here. 

This  paper  describes  the  development  of  a  simple  leader-follower  controller  that  permits  the  rear  module  to  follow  the 
front  module.  Here,  the  robot’s  geometry,  kinematic  constraints  and  the  user-commanded  velocities  are  used  to  calculate 
the  desired  instantaneous  center  of  rotation  the  robot  is  to  follow,  and  the  corresponding  central  linkage  angle  necessary 
for  the  back  module  to  follow  the  front  module  when  turning.  The  commands  to  the  rear  driving  motors  are  determined 
by  applying  proportional-integral-derivative  (PID)  control  on  the  error  between  the  desired  and  measured  linkage  angle 
position.  The  controller  is  tested  in  simulation  and  on  an  early  MSMR  prototype. 

2.  ROBOT  KINEMATIC  ANALYSIS 


This  section  presents  the  MSMR  kinematics.  For  this  analysis,  consider  the  robot  motion  on  a  planar  magnetic  surface, 
shown  in  Figure  4.  In  this  case  rotation  about  the  roll  axis  is  ignored  and  only  rotation  of  the  yaw  axis  is  considered. 
Assume  that  the  magnetic  adhesion  force  is  sufficient  to  keep  the  robot  in  contact  with  the  metal  surface,  and  that  the 
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Figure  4.  The  MSMR  position  in  an  inertial  frame. 

robot  doesn’t  slip. 

The  robot  position  in  an  inertial  frame  aligned  with  the  magnetic  surface  is  fully  described  by  the  vector  q  : 


q= 


Xi  d, 


(1) 


where  and  are  the  coordinates  of  the  front  module  center  of  mass,  assumed  located  in  the  front  drive  module’s 
geometric  center,  and  0^  and  the  orientations  of  the  front  and  rear  modules,  respectively.  The  position  of  the 

rear  module,  (^25  JF2  )  ’  related  to  the  position  of  the  front  module  by 


X2  =x^+d^cos0^+d2cos02 
J2  =yi+d^  sin^j  +(^2  sin^2 


(2) 


where  d^  and  ^^2  the  distances  from  the  front  and  rear  module  centers  of  mass  to  the  yaw  joint,  respectively. 
Differentiating  equation  (2)  yields  the  linear  velocities,  3^2  )  ’  the  second  module: 


X2  =  -  O^d^  sin 0^  -  4^2  O2 
j>2  =  j>i  +  O^d^  cos 0^  +  4^2  62 


(3) 


where  x^  and  y^  are  the  linear  velocities  of  the  front  module,  and  0^  and  62  are  the  rotational  velocities  of  the  first  and 
second  modules,  respectively.  Differentiating  Equation  (2)  again  yields  the  linear  accelerations,  (3^2 5  3^2  )  ’  the  second 
module: 


X2-x^-  O^d^  sin  0^  -  O^d^  cos  6^  -  62^2  sin  O2  -  0\d2  cos  62 
3^2  “  3^1  +  ^1^1  0^  -  O^d^  sin  6^  +  ^2^2  ~  O2 

where  x^  and  y^  are  the  linear  accelerations  of  the  front  module,  and  0^  and  O2  are  the  rotational  accelerations  of  the 
first  and  second  modules,  respectively. 

The  inertial  linear  velocities  of  a  drive  module  are  related  to  its  forward  velocity  V^.  in  a  body-centric  frame: 


i.=v^,.cos^. 

j>.=v,.sin^. 


(5) 


where  i  =  1,2,  and  1  refers  to  the  front  module  while  2  refers  to  the  rear  module.  The  body-centric  forward  velocity  of 
module  i  is  related  to  its  left  and  right  wheel  rotational  velocities: 


(6) 


where  is  the  wheel  radius,  is  the  right  wheel  rotational  velocity  and  CO^.  is  the  left  wheel  rotational  velocity. 
The  rotational  velocity  of  a  drive  module  is  also  related  to  its  wheel  velocities: 

w 


where  w  is  the  distance  between  the  right  and  left  wheels  of  the  drive  module. 


If  the  front  and  rear  modules  are  to  follow  the  same  circular  path  on  the  plane,  there  will  be  a  yaw  joint  angle  0.  ^  that 
will  permit  the  rear  module  to  follow  the  front  module.  Consider  the  moment  the  front  module  enters  a  curve,  while  the 
rear  module  maintains  its  previous  heading.  The  instantaneous  center  of  rotation  of  the  front  module,  ,  is: 

„  _^Ki+®/i)  (8) 

2Ki-^n) 

The  path  length  S  that  must  be  traveled  by  the  rear  module  before  it  enters  the  same  curve  is 

(9) 

At  the  moment  the  rear  module  enters  the  curve,  the  angle  6^  is  the  difference  in  orientation  between  the  front  and  rear 
modules.  This  angle  can  be  calculated  from  the  instantaneous  center  of  rotation  by  rewriting  Equation  (9): 


^  _d,+d^  _2{d,+d^){co^,-a^,) 


(10) 


Note  that  if  the  robot  is  traveling  on  a  straight  path,  is  infinite  and  the  desired  joint  angle  is  0. 

3.  LEADER-FOLLOWER  FEEDBACK  CONTROLLER 

A  simple  leader-follower  controller  is  desired  so  that  the  rear  module  follows  the  same  path  as  the  front  module.  The 
user  directly  drives  the  front  module  using  a  joystick,  which  sends  forward  and  turning  velocity  commands  that  are 
converted  into  left  and  right  motor  speeds.  The  leader-follower  controller  must  determine  the  commands  to  send  to  the 
right  and  left  rear  motors.  For  straight-line  motion,  one  could  simply  match  all  the  motor  speeds,  but  this  will  not  work 
while  turning.  As  described  in  Section  2,  there  is  a  path-dependent  yaw  joint  angle  that  permits  the  rear  module  to 
follow  the  front  module  regardless  of  the  path  curvature.  Using  the  kinematic  equations  above,  a  feedback  controller  that 
drives  the  yaw  joint  angle  to  the  desired  angle  can  be  implemented. 

Figure  5  shows  the  control  block  diagram  for  the  proposed  leader-follower  controller.  The  user  sends  linear  and  angular 
velocity  commands  to  the  front  module  which  are  translated  into  left  and  right  motor  speed  commands.  These  motor 
speed  commands  are  used  to  calculate  the  desired  yaw  joint  angle  using  Equation  (10).  Sensor  feedback  is  used  to 
calculate  the  error  between  the  desired  and  measured  joint  angle.  PID  control  on  this  error  and  an  additional  kinematic 
constraint  are  applied  to  determine  the  right  and  left  rear  motor  speed  commands,  as  explained  below.  Note  that  each 
motor  also  has  its  own  individual  controller. 


Figure  5.  Leader- follower  eontrol  bloek  diagram. 


The  robot  is  equipped  with  wheel  encoders,  an  IMU  on  each  module,  and  an  angular  position  sensor  on  its  yaw  joint. 
The  error  between  the  desired  and  measured  joint  angle  is  calculated  as: 


(11) 


e  =  d.  -d, 

J,m  a 


where  6 .  ^  is  the  measured  joint  angle.  The  change  in  this  error  can  be  calculated  using  the  encoder  measurements 
from  both  sets  of  wheels: 


e  — 6^— 62  —■ 


w 


(12) 


Using  these  errors,  a  PID  control  law  can  be  defined: 

u  =  -h  ICj  j  cdt -h  (13) 

where  u  is  the  commanded  angular  velocity  of  the  rear  module,  and^^  ,  Kj  and  are  the  proportional,  integral  and 

derivative  gains,  respectively.  The  angular  position  error  in  Equation  (13)  can  be  numerically  integrated  with  sufficient 
anti-windup  included  in  the  software  implementation. 

Both  a  forward  velocity  and  angular  velocity  are  needed  to  determine  the  right  and  left  wheel  commands.  The  angular 
velocity  command  is  determined  by  the  PID  controller.  The  robot  geometry  constrains  the  forward  speed  of  the  second 
module,  since  there  is  no  compliance  in  the  yaw  linkage.  Hence,  the  magnitudes  of  the  forward  velocities  of  both 
modules  must  remain  the  same  so  they  stay  connected.  Therefore: 

(14) 


The  left  and  right  rear  motor  speed  commands,  6:^2  r  c  ^^4  ^ ,  can  be  determined  by: 


(15) 


The  robot  geometry  imposes  limits  on  its  permissible  trajectories.  The  yaw  joint  has  a  range  of  (-45/45)  degrees,  which 
restricts  the  robot’s  ability  to  maneuver  in  a  tight  circle.  Hence,  there  is  a  minimum  instantaneous  center  of  rotation  that 
limits  the  difference  between  the  right  and  left  motor  speeds.  This  constraint  is  found  by  substituting  the  maximum 
range  into  Equation  (10)  and  rearranging: 


+  %) 

8  (  i/]  +  (^2  ) 


(16) 


A  model  of  the  MSMR  dynamics  is  needed  to  emulate  its  behavior  when  testing  the  leader-follower  PID  controller  in 
simulation.  Assume  that  the  magnetic  force  between  the  wheels  and  the  planar  surface  the  robot  travels  on  acts 
orthogonally  to  the  robot  motion.  The  following  state  model  can  be  derived  from  first  principles: 


M(q)v  +  H(v,q)  +  P(q)v  =  Bu 


(17) 


where  V  is  the  state  vector,  M(q)  is  the  mass  matrix,  vector  H(v,q)  contains  centripetal  terms,  p(q)  is  the 

dissipative  matrix,  B  is  the  input  matrix  and  U  is  the  control  vector.  The  individual  terms  of  the  matrices  are  found  in 
the  Appendix.  The  state  vector  V  is  defined  as 


CO.A  COi 


71 


CO, 


72 


V2 


(18) 


where  i  is  motor  current.  The  system  inputs  are  the  voltages  applied  to  the  motors: 


U 


V,.  V, 


12 


(19) 


The  PID  controller  was  tuned  and  partially  tested  in  Matlab  Simulink  before  implementation  on  the  MSMR.  Physical 
parameters  used  in  the  simulation  are  listed  in  Table  1. 

Table  1.  Physical  parameters  for  simulation. 


Module  mass  m 

2.5  kg 

Distance 

0.1303  m 

Distance 

0.1278  m 

Width  w 

0.2692  m 

Wheel  radius  r 

W 

0.0508  m 

Front  module  inertia  /j 

0.0252  kg-m^ 

Rear  module  inertia 

0.0249  kg-m^ 

Gear  box  ratio  N 

128 

Motor  torque  constant  Kj. 

0.0208  N-m/A 

Motor  voltage  constant  Ky 

0.0208  V/rad/s 

Motor  inductance  L 

0.186  mH 

Motor  resistance  R 

1.53  Ohms 

Motor  inertia  J 

1.47x10-5 

Motor  rotational  friction  b 

0.01  N-m/rad/s 

In  simulation,  the  robot  was  commanded  to  follow  circular  paths  at  various  forward  speeds,  and  the  controller  gains  were 
tuned  iteratively.  Figure  6  and  Figure  7  show  the  simulated  position  histories  of  the  front  and  rear  modules  at  forward 
velocities  of  8  cm/s  and  20  cm/s,  respectively.  Note  that  the  robot  has  a  maximum  forward  speed  of  approximately  30 
cm/s,  but  is  unable  to  turn  while  maintaining  that  forward  speed.  In  both  instances,  the  rear  module  path  converges  to 
the  front  module  path,  albeit  more  quickly  at  lower  forward  speed.  The  controller  gains  that  resulted  in  satisfactory 

performance  under  a  wide  variety  of  trajectories,  including  the  two  presented  are  proportional  gain  Kp  of  1,  integral 
gain  Kj  of  2  and  derivative  gain  Kp  of  0.5.  These  gains  are  used  as  starting  points  for  physical  implementation. 


X  (meters) 

Figure  6.  Front  and  rear  module  position  history,  mean  veloeity  8  em/s. 


Figure  7.  Front  and  rear  module  position  history,  mean  veloeity  20  em/s. 


4.  EXPERIMENTAL  RESULTS 

To  test  the  validity  of  MSMR  with  a  leader-follower  controller,  a  number  of  experiments  were  run  on  a  large  flat  metal 
surface  as  shown  in  Figure  8  and  Figure  9.  A  cylinder  with  a  dry  erase  marker  was  taped  to  each  robot  module  so  that  a 
line  would  be  scribed  on  the  ground  to  illustrate  the  path  of  each  module.  A  blue  marker  was  used  for  the  leading 
module  and  red  for  the  trailing  module. 

The  first  experiment  consisted  of  testing  MSMR  at  a  velocity  of  8  cm/s  using  the  PID  values  found  in  simulation  (Figure 
6).  The  simulation  results  exhibited  a  deviation  (illustrated  by  the  dashed  line  as  it  transitions  from  the  straight  line  to 


the  circle  in  Figure  6)  than  the  experimental  result.  The  absence  of  overshoot  in  the  real-world  experiment  was  likely 
due  to  the  ability  of  the  robot  to  overpower  the  bond  between  the  wheel  magnets  and  the  metal  surface,  causing  wheel 
slip  that  was  not  allowed  during  the  simulation.  However,  during  the  experiment  the  robot  exhibited  an  undesired 
oscillatory  trajectory  while  following  the  prescribed  path  (see  Figure  8).  This  behavior  was  likely  created  by  a 
combination  of  aggressive  PID  values  (specifically  the  high  derivative  gain)  and  small  differences  between  the  simulated 
and  experimental  physical  parameters. 


Figure  8.  MSMR  Driving  a  Loop  with  PID  Gains  Kp=l,  Ki=2,  Kd=0.5,  mean  veloeity  8  em/s.  The  blue  traee  was 
drawn  by  a  marker  attaehed  to  the  front  module,  and  the  red  traee  was  drawn  by  one  attaehed  to  the  rear  module. 

In  the  next  set  of  experiments,  the  MSMR  was  driven  in  a  path  at  varied  speeds  along  circles  of  different  diameters. 
During  the  course  of  these  experiments,  the  physical  limitations  of  the  MSMR  were  measured  (i.e.  actuator  saturation, 
maximum  angular  rate,  minimum  turn  radius)  and  compared  to  what  had  been  coded  in  the  simulations.  Throughout 
these  experiments  the  PID  controller  was  iteratively  tuned  until  acceptable  gains  were  found.  A  PI  controller  with  gains, 
Kp  =  0.35,  Ki=5.0e-5,  and  Kd=0  was  found  to  be  sufficient  to  allow  for  good  path  convergence  of  the  rear  module  to  the 
front  module. 

With  the  new  controller  gains,  the  first  experiment  was  run  again.  MSMR  did  significantly  better  at  following  the 
circular  path  with  both  modules  in  this  case  (see  Figure  9).  The  trajectory  shows  the  rear  module  (red  line)  tracking  the 
front  module  (blue  line)  with  very  little  error  and  both  modules  closing  the  circular  path  they  were  driving. 


Figure  9.  MSMR  Driving  a  Loop  with  PI  Gains  Kp=0.35,  Ki=5.0e-5,  mean  veloeity  8  em/s. 


5.  CONCLUSIONS 


A  simple  leader-follower  controller  for  the  MSMR  robot  is  developed.  A  kinematic  analysis  of  its  motion  shows  that  for 
every  instantaneous  center  of  rotation  of  the  front  module,  there  is  a  corresponding  yaw  joint  angle  that  permits  the  rear 
module  to  follow  the  front  module.  Leader-follower  control  is  achieved  by  applying  PID  control  on  the  error  between 
the  measured  and  desired  yaw  joint  angle  to  determine  the  rear  motor  speeds.  The  controller  concept  is  tested  in 
simulation,  and  then  implemented  in  hardware.  Experiments  show  that,  with  appropriate  tuning,  the  simple  leader- 
follower  controller  developed  and  presented  in  this  paper  is  sufficient  in  controlling  the  MSMR. 
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APPENDIX 

Dynamic  Model  Matrices 


The  terms  in  the  mass  matrix  M(q)  are: 
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where  m.  is  the  mass  of  the  zth  module,  N  is  the  gearbox  ratio  between  the  motor  and  the  wheel,  J  is  the  rotational 
inertia  of  the  motor,  /.  is  the  inertia  of  the  zth  module,  and  L  is  the  motor  inductance. 


The  vector  H(v,q)  is: 
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The  terms  in  the  dissipative  matrix  P(q)  are: 
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where  b  is  the  motor  rotational  friction  constant,  is 
resistance. 

The  input  matrix  B  is: 
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the  motor  torque  constant  and  R  is  the  motor  electrical 
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